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Abstract 
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Deutschsprachige Ubersetzung der Beschreibung der 
Europaischen Patentanmeldung Nr. 89105819.0-2206 des 
Europaischen Patents Nr.O 336 342 

5 Hinterarund der Erfinduna 

# , Diese Erfindung bezieht sich auf einen industriellen Robo- 
ter bzw. einen Industrieroboter , der einen Arbeitspunkt vor 
dem Bearbeiten des Punkts mit einem Form-Sensor abtastet. 

10 

Es gibt viele Arten von Industrierobotern . Einige haben 
einen Sensor zum Abtasten gewisser Bezugspunkte oder Linien 
eines Werkstiicks. Bei einem Steuersystem fur derartige Ro- 
boter erfaBt ein vor einem Werkzeug angeordneter Sensor die 

15 Bezugspunkte und erfaBt jeden Form- oder Einstellf ehler des 
Werkstiicks. Unter Verwendung der erfaBten Fehler werden 
wahrend der Prof ilsteuerung Interpolationswerte fur den 
Standard-Weg sequentiell korrigiert. Jedoch weist dieses 
Steuersystem ein Problem bei der Zeitablauf steuerung auf, 

20 wenn die erfaBten Daten des Sensors zur Korrektur der In- 
terpolationswerte verwendet werden. Insbesondere ist das 
Herstellen eines Zusammenhangs zwischen einem Punkt Tl , 
wenn der Sensor einen Arbeitspunkt erfaBt, und einem Punkt 
T2 , wenn das Werkzeug den Erf assungspunkt wirklich er- 

25 reicht, in Echtzeit aus verschiedenen Grunden schwierig, 
beispielsweise wegen der Arbeitsgeschwindigkeit und Verzo- 
gerungen im Servo-System des Robpters. 

Zum Losen dieses Problems wurde das folgende Verfahren vor- 
30 geschlagen: von dem Sensor erfaBte Werkstuckf orm-Daten wer- 
den in einem FIFO-Zwischenspeicher gespeichert, wobei die 
altesten dieser Daten zum Berechnen der Interpolationswerte 
fur das dem Sensor folgende Werkzeug herangezogen werden 
(Japanische Patentof f enlegungsschrif t Nr. 26276/1988). Bei 
35 diesem Verfahren kann die Zeit zum Beginnen der Weg-Korrek- 
tur entsprechend der Arbeitsgeschwindigkeit eingestellt 
werden, wenn die Arbeitsgeschwindigkeit des Roboters gleich 
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der Geschwindigkeit ist, mit der die im Zwischenspeicher 
gespeicherten Werkstuckf orm-Daten verwendet werden. Somit 
erlaubt es eine prazise Prof ilsteuerung fur verschiedene 
Arbeitsgeschwindigkeiten des Roboters , solange die 
5 Geschwindigkeit wahrend eines Betriebs konstant ist. 

Dieses Steuersystem kann jedoch nicht immer eine genaue 
Prof ilsteuerung erzielen: wenn der Roboter wahrend eines 
Betriebs die Arbeitsgeschwindigkeit andert, gilt die Bezie- 
hung zwischen der Zeitablauf steuerung zur Verwendung der 
Werkstuckf orm-Daten im Zwischenspeicher zur Weg-Korrektur 
und dem wirklichen Arbeitspunkt des Roboters nicht mehr 
langer. Die Arbeitsgeschwindigkeit eines Roboters kann sich 
wahrend des Betriebs aus folgenden Griinden andern. 

(1) Im allgemeinen verandern Roboter die Arbeitsge- 
schwindigkeit am Anfang oder am Ende des Betriebs , um unno- 
tige Oszillationen zu verhindern. 

(2) Die Arbeitsgeschwindigkeit muB an verschiedene ortliche 
Gegebenheiten, beispielsweise Ebenen und Ecken , angepaftt 
werden . 

(3) Zum Laserschneiden verwendete Roboter bewegen sich auf 
flachen und geraden Teilen des Werkstiicks schnell und in 
Kurven langsam, um die gesamte Arbeitsdauer zu verringern. 
Wenn die Arbeitsgeschwindigkeit festgelegt ist, muB der Ro- 
boter sich uber das gesamte Werkstiick langsam bewegen. Da 
der Roboter sich wahrend eines Betriebs nie auf lediglich 

30 einer Linie bewegt, werden typischerweise mehrere Standard- 
Wege auf der Grundlage mehrerer Lernpunkte gelernt. Somit 
verandert sich notwendigerweise der Weg des Roboters . 

Zusammenf assung der Erfindung 

35 

Die vorliegende Erfindung erlaubt einem Roboter, ohne Be- 
rucksichtigung von Anderungen der Arbeitsgeschwindigkeit 
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oder des Wegs des Roboters, wahrend eines Betriebs eine ge- 
eignete Prof ilsteuerung reproduzierbar auszuf iihren . 

Das Steuersystem fur einen Industrieroboter R4 ist wie in 
Fig- 1 dargestellt- Der Roboter R4 bewegt sich auf einem 
durch zuvor in dem System gespeicherte Daten bestimmten 
Standard-Weg und hat eine Hand Rl mit einem Werkzeug R2 und 
einen in einem vorbestimmten Abstand vor dem Werkzeug R2 
angeordneten Werkstiickf orm-Sensor R3 zum Erfassen eines 
Werkstiicks. Das System umfaBt eine Zwischenspeicher- 
einrichtung R5 zum Berechnen und Speichern von Werkstiick- 
f orm-Daten unter Verwendung der Daten des Sensors R3 , eine 
Interpolations -Best immungseinrichtung R6 zum Interpol ier en 
eines Punkts auf dem Standard-Weg als eine Zielposition des 
Werkzeugs R2 , eine Auswahleinrichtung R7 zum Erzeugen eines 
dem Interpolationspunkt auf dem Standard-Weg entsprechenden 
Bezugspunkts und zum Auswahlen der am besten mit den Be- 
zugspunkt-Daten iibereinstimmenden Werkstiickf orm-Daten , eine 
Weg-Korrektureinrichtung R8 zum Erzeugen der Zielposition 
und Stellungs-Daten fiir das Werkzeug aus den von der 
Auswahleinrichtung R7 empfangenen Werkstiickf orm-Daten , und 
eine Roboter-Steuereinrichtung R9 zum Steuern des Werkzeugs 
R2, urn einer Folge von einer Zielposition entsprechenden 
Punkten sowie Stellungs-Daten von einer Weg-Korrekturein- 
richtung R8 zu folgen. Dieses Steuersystem ist gekennzeich- 
net durch einen Roboter, der die Abweichung vom Standard- 
Weg wahrend des Betriebs des Werkzeugs R2 in Echtzeit kor- 
rigiert . 

Bei diesem System bestimmt der Standard-Weg die Verarbei- 
tungsreihenf olge fur das Werkstuck, die Position des Werk- 
zeugs R2 mit Bezug auf das Werkstiick sowie die Arbeits- 
geschwindigkeit . Der Standard-Weg wird durch im voraus ge- 
speicherte Positionsdaten gebildet, die wahrend einer Lern- 
funktion von einem Bediener eingegeben wurden. Der Werk- 
stiickf orm-Sensor R3 an der Hand Rl kann den Abstand zwi- 
schen dem Sensor und dem Werkstiick oder eine Form des Werk- 
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stucks erfassen (d. h. eine Richtung des Normal envektors 
der Arbeitsoberf lache) . Der Sensor R3 kann ein beriihrungs- 
loser Sensortyp sein (beispielsweise ein Laser-Entf ernungs- 
sensor) oder ein mit Befiihrung arbeitender Sensortyp ^ sein 
5 (beispielsweise ein Draht-MeBf uhler ) . 

Wenn die Stellung des Werkzeugs R2 unveranderlich ist, kann 
der Roboter R4 ein einfacher zweiachsiger Typ mit zwei 
Freiheitsgraden sein: eine zum Steuern des Abstands zwi- 
schen der Hand Rl und dem Werkstiick und die andere fur eine 
zum Abstand senkrechte Bewegung. Der Roboter R4 kann ebenso 
ein mehrachsiger oder mehrgelenkiger Roboter mit beispiels- 
weise ftinf oder sechs Drehachsen sein. In diesem Fall kann 
die Stellung des Werkzeugs zusatzlich zur Position einge- 
stellt werden. Bei der mit dem Werkzeug R2 ausgefuhrten Ar- 
beit kann es sich urn SchweiBen, Anstreichen, Schneiden, Zu- 
richten, Bohren, andere Laserverfahren, Montieren, Messen 
von Abmessungen und Qualitatskontrolle beztiglich 
Oberf lachendef ekten oder Stiftlochern handeln. 

Die Zwischenspeichereinrichtung R5 besteht aus einer Logik- 
schaltung und einem Speicher, der von dem Sensor R3 erfaBte 
Daten zwischenzeitlich speichert. 

25 Die Interpolations-Bestimmungseinrichtung R6 wahlt einen 
Interpolationspunkt auf dem Standard-Weg aus, den das Werk- 
zeug passieren wird. Der Interpolationspunkt stellt die Po- 
sitionsdaten dar, die den Standard-Weg bilden (beispiels- 
weise die Arbeitsgeschwindigkeit und der Weg) . 

30 

Die Auswahleinrichtung R7 erzeugt einen dem Interpolations- 
punkt auf dem Standard-Weg entsprechenden Bezugspunkt. Der 
Bezugspunkt wird zum Auswahlen der zur Korrektur geeignet- 
sten Werkstuckf orm-Daten verwendet. Beispielsweise kann der 
3 5 Bezugspunkt ein Interpolationspunkt auf dem Standard-Weg 
oder der Endpunkt eines Vektors sein, dessen Startpunkt ein 
der derzeitigen Werkzeugposition entsprechender Punkt auf 
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dem ' Standard-Weg ist und dessen Endpunkt der 
Interpolationspunkt auf dem Standard-Weg ist, wenn der 
Startpunkt des Vektors die derzeitige Werkzeugposition ist. 
In diesem Fall kann der Startpunkt auf dem Standard-Weg ein 
5 von der derzeitigen Werkzeugposition auf den Standard-Weg 
projizierter Punkt sein. Deshalb wahlt die Auswahleinrich- 
tung R7 zum Korrigieren des Wegs Werkstuckf orm-Daten aus, 
die dem B t ezugspunkt am nachsten liegen. 

10 Die Weg-Korrektureinrichtung R8 berechnet und erzeugt ent» 
sprechend den ausgewahlten Werkstuckf orm-Daten Zielpositi- 
ons- und Stellungs-Daten fur das Werkzeug, indem die 
vorbestimmten Beziehungen der Position und Stellung zwi- 
schen dem Werkstiick und dem Werkzeug in Betracht gezogen 

15 werden. 

Die Steuereinrichtung R9 steuert das Werkzeug R2 zum auf- 
einanderf olgenden Erreichen einer Reihe von den Zieldaten 
der Korrektureinrichtung R8 entsprechenden Punkten in der 
20 gleichen Weise wie bei dem herkommlichen Steuerverf ahren . 

Die Auswahleinrichtung R7 umfaSt vorzugsweise eine Berech- 
nungseinrichtung zum Berechnen eines Bezugsvektors aus den 
Werkstuckf orm-Daten oder dem Standard-Weg, eine 

25 Pro jektionseinrichtung zum Projizieren eines vorbestimmten 
Pro jektions-Punkts auf den Bezugsvektor , und eine Vektor- 
Auswahleinrichtung zum Auswahlen der Werkstuckf orm-Daten 
mit dem geringsten Abstand zwischen dem projizierten Punkt 
und einem vorbestimmten Vergleichspunkt auf dem Bezugsvek- 

30 tor. 

Es kann eine Anordnung der Erfindung geschaffen werden, bei 
der der Bezugsvektor aus Werkstuckf orm-Daten bestimmt wird; 
der Pro jektionspunkt der einer von dem Werkzeug zu errei- 
3 5 chenden angenaherten Werkzeugposition aquivalente Bezugs- 
punkt ist, wobei die Werkzeugposition aus dem Standard-Weg 
und einem tatsachlichen Weg angenahert wird; unci der Ver- 
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gleichspunkt durch die von dem Werkstiickf orm-Sensor erfaB- 
ten Daten bestimmt ist. 

Die Erfindung kann ebenfalls derart aufgebaut sein, da£ der 
Bezugsvektor der Standard-Weg ist; der Pro jektionspunkt 
durch die von dem Werkstiickf orm-Sensor erfafiten Daten be- 
stimmt ist; und der Vergleichspunkt ein dem Interpolations- 
punkt auf dem Standard-Weg aquivalenter Bezugspunkt ist. 

Ferner kann die Bezugslinie entweder ein zwei benachbarte 
erfaBte Datenpunkte verbindender Vektor sein, ein zwei in 
einem vorbestimmten Interval 1 erfaBte Datenpunkte verbin- 
dender Vektor oder ein einen erfaftten Datenpunkt und einen 
die Position der Werkzeugspitze beschreibenden Datenpunkt 
zum Zeitpunkt des Erfassens des erfaBten Datenpunkts ver- 
bindender Vektor sein. 

Es ist am besten, wenn die Zwischenspeichereinrichtung R5 
die alten Werkstiickf orm-Daten loscht, urn Platz fur neue 
Zielpositions-Daten fiir das Werkzeug zu schaffen. 

Der Roboter R4 steuert die Hand Rl mit dem Werkzeug R2 wie 
folgt. 

(1) Die Zwischenspeichereinrichtung R5 berechnet und spei- 
chert Werkstiickf orm-Daten, die durch Verwenden des dem 
Werkzeug R2 voreilenden Sensors R3 erhalten werden . 

(2) Die Interpolations-Bestimmungseinrichtung R6 wahlt 
einen Interpolationsweg auf dem von dem Werkzeug R2 ver- 
folgten Standard-Weg aus. 

(3) Die Auswahleinrichtung R7 erzeugt dem Interpolati- 
onspunkt entsprechende Bezugspunkt-Daten und verwendet die 
Bezugspunkt-Daten zum Auswahlen der zur Korrektur des Wegs 
geeignetsten Werkstiickf orm-Daten . 



(4) Die Weg-Korrektureinrichtung R8 berechnet aus den Werk- 
sttickf orm-Daten eine Zielposition unci Lageposition fur das 
Werkzeug R2 , und eine Roboter-Steuereinrichtung R9 steuert 
die Hand Rl derart, daS das Werkzeug R2 einer Reihe von 
Punkten folgt. 

Fig. 2 stellt das verfahren zum Berechnen der Zielposition 
und der Stellung des Werkzeugs R2 dar, wobei das Verfahren 
Schritte enthalt zum Erhalten eines Bezugspunkts Nd, der 
dem von dem Werkzeug R.2 auf dem Standard-Weg S zu errei- 
chenden Interpolationspunkt Sd entspricht, zum Bestiiamen 
der Arbeitsgeschwindigkeit (das heiBt, der Bewegungsge- 
schwindigkeit des Werkzeugs R2) und des Wegs , zum Auswahlen 
der dem Bezugspunkt Nd am nachsten kommenden Werkstiickf orm- 
Daten Wd, zum Berechnen der Zielposition und der Stellung 
des Werkzeugs R2 aus den ausgewahlten Werkstuckf orm-Daten 
Wd, und zum Korrigieren des Wegs des Werkzeugs R2 . 

Wenn die Arbeitsgeschwindigkeit Oder der Weg wahrend des 
Betriebs verandert wird, beeinfluBt eine derartige Anderung 
direkt die Interpolationspunkte auf dem Standard-Weg , so 
daB das Werkzeug R2 veranderlichen Arbeitsgeschwindigkeiten 
und veranderlichen Wegen exakt folgen kann. 

Beschreibung der Zeichnung 
Es zeigen: 

Fig. 1 ein Blockschaltbild der Erfindung; 

Fig. 2 ein Beispiel der in Betrieb befindlichen Erfindung; 

Fig. 3 eine perspektivische Ansicht eines Ausf uhrungsbei- 
spiels der Erfindung; 

Fig. 4A eine Draufsicht auf das Stellglied 16; 
Fig. 4B eine Frontansicht des Stellglieds 16; 
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Fig. 4C eine linksseitige Ansicht des Stellglieds 16; 

Fig. 5 eine perspektivische Ansicht der Hand 18; 

Fig. 6 ein Blockschaltbild der Sensor-Steuereinrichtung 24 
mit einem Beispiel derselben beim Erfassen eines Abstands; 

Fig. 7 ein Blockschaltbild der Roboter-Steuereinrichtung 
12; 

Fig. 8 ein Blockschaltbild des ersten Ausf uhrungsbeispiels ; 

Fig. 9 eine Darstellung der Positionsbeziehung zwischen den 
bei dem ersten Ausf iihrungsbeispiel verwendeten Punkten; 

Fig. 10 ein Blockschaltbild der Roboter-Steuereinrichtung 
12 bei dem ersten Ausf iihrungsbeispiel ; 

Fig. 11 die Einteilung des Werkstuckf orm-Speichers 406; 

Fig. 12 eine Erklarung der Positionsbeziehung zwischen den 
fur den Speicher 406 verwendeten Punkten; 

Fig. 13 ein FluBdiagramm der Verarbeitung in der ersten CPU 
300; 

Fig. 14 ein FluBdiagramm der Verarbeitung in der zweiten 
CPU 3 01; 

Fig. 15 ein Blockschaltbild des zweiteji Ausf uhrungsbei- 
spiels; 

Fig. 16 ein Blockschaltbild der Roboter-Steuereinrichtung 
12 bei dem zweiten Ausf iihrungsbeispiel ; 

Fig. 17 die Einteilung des Werkstuckf orm-Speichers 706; 
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Fig. "18 eine Erklarung der Positionsbeziehung zwischen den 
fur den Speicher 706 verwendeten Punkten; 



Fig. 19 ein FluBdiagramm der zweiten CPU 301; 

5 

Ausfiihrungsbeispiel 

Bei diesem Ausfiihrungsbeispiel handelt es sich um einen 
sechsachsigen Roboter, der zum Bearbeiten eines Werkstiicks 

10 mit einem einen Laserstrahl verwendenden Werkzeug sowie mit 
einem Sensor zum Erfassen der Form des Werkstiicks an einer 
noch nicht bearbeiteten Position ausgestattet ist. Wie in 
der Perspektivansicht des Robotersystems gemaB Fig. 3 ge- 
zeigt, hat ein Roboter 10 eine Roboter-Steuereinrichtung 12 

15 fur die gesamte Steuerung des Roboters 10, eine Lern-Ein- 
richtung 14 bei der Roboter-Steuereinrichtung 12, die es 
einem Bediener ermoglicht, dem Roboter 10 im voraus beizu- 
bringen, wie eine Aufgabe zu erfiillen ist, ein Stellglied 
16 mit sechs Drehachsen, das von der Roboter-Steuer- 

20 einrichtung 12 gesteuert wird, eine Hand 18 mit einem 
Laserwerkzeug 20 und einem Sensorkopf 22 zum Erfassen der 
Form eines Werkstiicks W sowie eine Sensor-Steuereinrichtung 
bzw. einen Sensor-Controller 24 zum Verarbeiten von 
Inf ormationen von dem Sensorkopf 22. Die Roboter-Steuerein- 

25 richtung 12 hat eine Datenendstation bzw. ein Terminal T 
und einen Drucker P. 

Das Werkzeug 20 verwendet einen von einer (nicht gezeigten) 
externen Einrichtung erzeugten Hochenergie-Laserstrahl . Ein 

30 Lichtleiter 26 leitet den Laserstrahl zur Spitze des Werk- 
zeugs 20, von wo aus ein Punkt der Oberflache des Werk- 
stiicks W mit dem Strahl angestrahlt wird. Weitere Bauteile 
. des Laserwerkzeugs 20, beispielsweise Spiegel , Prismen und 
Linsen sind fur die vorliegende Erfindung nicht von Bedeu- 

35 tung, so daB sie nicht gezeigt sind. 
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Der Sensorkopf 22 erfaBt die Position des Werkstucks w re- 
lativ zu dem Sensorkopf 22, und erfaBt ebenso die Stellung 
des Werkstucks W mittels einer Kombination aus drei Entfer- 
nungssensoren (vergleiche Fig. 5). Daten von dem Sensorkopf 
.22 werden durch eine Sensor-Datenleitung 28 zum Sensor-Con- 
troller 24 iibertragen, wo sie verarbeitet werden. 

Das in den Fig. 4A bis 4C dargestellte Stellglied 16 hat 
sechs Drehachsen: Die erste , zweite und dritte Achse steu- 
ern die Position der Hand 18 bezogen auf das Werkstiick W; 
und die vierte, fiinfte und sechste Achse steuern die stel- 
lung der Hand 18 bezogen auf das Werkstiick W. Jede Achse 
hat einen Motor, eine Bremse und eine Codiereinrichtung 
(das heiBt, einen Drehwinkelsensor) : die erste Achse hat 
einen ersten Motor 30, eine erste Bremse 3 2 und einen er- 
sten Winkelsensor 34; die zweite Achse hat einen zweiten 
Motor 40, eine zweite Bremse 42 und einen zweiten Winkel- 
sensor 44; die dritte Achse hat einen dritten Motor 50, 
eine dritte Bremse 52 und einen dritten Winkelsensor 54; 
die vierte Achse hat einen vierten Motor 60, eine vierte 
Bremse 62 und einen vierten Winkelsensor 64; die fiinfte 
Achse hat einen fiinften Motor 70, eine funfte Bremse 72 und 
einen fiinften Winkelsensor 74; und die sechste Achse hat 
einen sechsten Motor 80, eine sechste Bremse 82 und einen 
sechsten Winkelsensor 84. Drehungen urn die zweite Achse und 
die dritte Achse durch die Motoren 40 und 50 werden mit 
entsprechenden Kugelumlauf spindelschiebern 90 und 92 in li- 
neare Bewegungen umgewandelt, und die linearen Bewegungen 
werden mit Parallelverbindungen in Drehungen urn die Achsen 
umgewandelt. Drehungen urn die anderen Achsen werden mit den 
entsprechenden Motoren der Achsen iiber Drehmomentwellen , 
Untersetzungsgetrieben, Schraubgetrieben und anderen tiber- 
tragungsvorrichtungen angetr ieben . 

In Fig. 5 sind das Laserwerkzeug 20 und der Sensorkopf 22 
mit einem vorbestimmten Abstand dazwischen an der Hand 18 
befestigt. Die relativen Positionen des Werkzeugs 20 und 
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des Sensorkopfs 2 2 sind unveranderlich, unabhangig von der 
Bewegung der Hand 18. Der Sensorkopf 22. hat drei Entfer- 
nungssensoren 102, 104 & 106. Die Hand 18 bewegt sich der- 
art liber das Werkstuck W, daB der Sensorkopf 22 dem Werk- 
5 zeug 20 voreilt. Anders ausgedriickt, der Sensorkopf 22 er- 
faBt einen Punkt PI auf einer Werkstuckoberf lache , den das 
Werkzeug 20 bearbeiten wird, nachdem es seine derzeitige 
Bearbeitung am Punkt P0 beendet hat. 

10 Der Sensorkopf 22 erfaBt den Punkt PI unter Verwendung der 
drei Entf ernungssensoren 102, 104 & 106 , um die Entfernung 
und die Richtung dreier Punkte Pll, P12 & P13 der entspre- 
chenden Sensoren 102, 104 & 106 zu messen. Der Sensor-Con- 
troller 24 berechnet dann die Position und die Neigung des 

15 Punkts PI auf der Grundlage des gemessenen Ergebnisses. Die 
Punkte Pll, P12 & P13 sind tatsachlich sehr nahe bei dem 
Punkt PI, sind jedoch zum Vereinfachen der Erklarung in 
Fig. 5 weiter entfernt dargestellt. 

20 Fig. 6 zeigt ein Blockschaltbild des Sensorkopfs 22 und des 
Sensor-Controllers 24. Jeder Ehtf ernungssensor 102, 104 & 
106 erfaftt die Entfernung zu einem Oberf lachenpunkt LC auf 
dem Werkstuck W mittels dem folgenden Verfahren (der Kiirze 
wegen ist dieses Verfahren nur fur den Sensor 102 be- 

25 schrieben) . Der Entf ernungssensor 102 enthalt eine Laserdi- 
ode 200 zum Emittieren eines Laserlichts mit einer Wellen- 
lange von etwa 750 /im, einen Impulsmodulator 202 zum Pul- 
sieren bzw. Pulsen des Laserlichts mit einem voreingestell- 
ten Betriebsdauerverhaltnis , eine Kollimatorlinse 204 zum 

30 Sammeln des Laserlichts, eine eindimensionale positionsemp- 
findliche Einrichtung 206, nachfolgend aTs PSD-Einrichtung 
("Position Sensitive Device" ) bezeichnet , der Lange 2 • L, 
eine Ob jektivlinsse 208 zum Bundeln des von der 
Werkstuckoberf lache ref lektierten Lichts auf die PSD-Ein- 

35 richtung 206, und zwei Vorverstarker 210 & 212 zum Wandeln- 
eines photoinduzierten elektrischen Stroms Io der PSD-Ein- 
richtung 206 in entsprechende Spannungen. 



- 12 - 

Die PSD-Einrichtung 206 ist aus Silizium-Photodioden herge- 
stellt, bei denen eine p-Typ Widerstandsschicht auf einem 
hochohmigen Siliziumsubstrat (i-Schicht) vorgesehen ist, 
zwei Elektroden an* beiden Enden der Schichtstruktur zum Ab- 
5 geben von Signalen vorgesehen sind, und eine gemeinsame 
Elektrode auf der Oberflache des hochohmigen Siliziumsub- 
- strats (i-Schicht) vorgesehen ist. Wenn Licht auf eine be- 
stimmte Stelle der Oberflache der p-Typ Schicht fokussiert 
wird, wird an dieser Stelle der elektrische Strom Io er- 

10 zeugt. Der Strom Io wird in zwei Anteile II und 12 aufge- 
teilt, die von den Elektroden an den entgegengesetzten En- 
den der PSD-Einrichtung 206 abgegeben werden . Wenn die fo- 
kussierte Stelle urn eine Entfernung X von der Mitte der 
PSD-Einrichtung 2 06' der Lange 2L verschoben wird, sind die 

15 entsprechenden, von der PSD-Einrichtung 206 an die 
Vorver starker 210, 212 abgegebenen Strome II und 12 durch 
die folgenden Formeln gegeben: 

11 = Io-(L + AX) /(2-L) und 

12 = Io-(L - AX)/(2.L) -..(1). 
20 Der Strom Io wird namlich im umgekehrten Verhaltnis des Wi- 

derstands von der fokussierten Stelle zu den entsprechenden 
Stirnf lachem-Elektroden auf geteilt . 

Das die Laserdiode 200, die Kollimatorllinse 204, die Ob- 
25 jektivlinse 208 und die PSD-Einrichtung 206 enthaltende op- 
tische System ist derart angeordnet, daft: 

(1) wenn die Achse des einfallenden Laserlichts und 
die Achse des ref lektierten Lichts einen Winkel 6 bilden, 
das reflektierte Laserlicht die Mitte der PSD-Einrichtung 

30 206 passiert, und 

(2) in diesem Fall ein zwischen der Achse des ref lek- 
tierten Lichts und der PSD-Einrichtung 206 gebildeter Win- 
kel 0 auf einen derartigen Wert eingestellt wird, daB das 
von dem angestrahlten Punkt LC auf der Werkstuckoberf lache 

35 reflektierte Laserlicht, unabhangig von der Position des 
Punkts LC, auf der Oberflache der PSD-Einrichtung fokus- 
siert wird. 
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Somit gemigen eine Verschiebung X des Werkstiicks W (das 
heist, eine Anderung der Entfernung zwischen dem Entfer- 
nungssensor 102 und dem Werkstuck W) und die Verschiebung 
des Brennpunkts von der Mitte der PSD-Einrichtung 2 06 
5 der folgenden Beziehung: 

^X = (l / cos 0)*{Bo - (Ao-f + f-X-cos 6) / { (Ao - f) 
+X-COS S) } . . . (2) 

wobei f die Brennweite der Ob jektivlinse 208, Ao die Ent- 
fernung zwischen dem angestrahlten Punkt LC und der Objek- 
10 tivlinse 208, wenn die Achse einfallenden Lichts und die 
Achse ref lektierten Lichts einen Winkel 8 einnehmen, und Bo 
die Entfernung zwischen der Ob jektivlinse 208 und dem Mit- 
telpunkt der PSD-Einrichtung 206 ist. 

15 Aus Formel (1) und einer allgemeinen Formel (1/f = 1/Ao + 
1/Bo) , die eine Beziehung zwischen Brennweiten darstellt, 
wird die folgende Formel abgeleitet: 
/ x /L = (II - I2)/(I1 + 12) 

= K-x/(l + a-x) . - . (3 ) 

20 wobei K = ((cos. 5) -(Bo - f))/(L-(cos e) • (Ao - f)) und 
a - (cos 5)/(Ao - f) ist. 

Wie aus Formel (3) hervorgeht , wird die Verschiebung X des 
Werkstiicks W bezogen auf den Entf ernungssensor 102 be- 

25 stimmt, indem die Ausgangsstrome II und 12 an den entgegen- 
gesetzten Enden der PSD-Einrichtung 206 gemessen werden . 
Die Berechnung von Formel (3) wird bei diesem Ausfiih- 
rungsbeispiel in Berechnungseinrichtungen 214, 216 & 218 
des Sensor-Controllers 24 durchgef uhrt . Da alle drei 

30 Berechnungseinrichtungen 214, 216 & 218 den gleichen Aufbau 
aufweisen, wird lediglich die Einrichtung ~214 beschrieben. 

Eine Positions-Bestimmungseinrichtung 224 in der Berech- 
nungseinrichtung 214 empfangt die Ausgangsstrome II und 12 

35 von der PSD-Einrichtung 206 uber entsprechende Eingabe- 
Zwischenspeicher 220 und 222 und berechnet (II - 12) /(II + 

.... —1.2).—. -Die Positions-Bestimmungseinrichtung 224 erzeugt ein 
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Signal, das das Berechnungsergebnis darstellt und zu /\X/L 
proportional ist, und fuhrt das Signal einer 
Linearisierungseinrichtung 226 zu, von der das Signal kor- 
rigiert wird, damit es der Verschiebung X des Werkstucks W 
5 proportional ist. Das Ausgangssignal der Linearisierungs- 
einrichtung 226 wird mit einer A/D-Wandlereinrichtung bzw- 
einem A/D-Konverter 228 in ein digitales Signal gewandelt, 
um in einer Sensor-Eingabe-Schnittstelle 230 der Roboter- 
Steuereinrichtung 12 verarbeitet zu werden. 

10 

In Fig. 7, ist die Roboter-Steuereinrichtung 12, die eine 
Verarbeitungs-Steuereinrichtung fur das sechsachsige Stell- 
glied 16 und eine Lern-Steuereinrichtung fur den Roboter 10 
ist, ein Mikrocomputer mit einer ersten 

15 Zentralverarbeiturlgseinheit bzw. CPU 300, einer zweiten CPU 
301, einem Festspeicher bzw. ROM 302, einem Schreib-Lese- 
Speicher bzw. RAM 3 04, einem Sicherheits- bzw. Backup-RAM 
306 und weiteren elektronischen Bauteilen, die uber eine 
Sammelleitung bzw. einen Bus 308 miteinander verbunden 

20 sind, wobei all diese Bauteile allgemein bekannt und ge- 
brauchsf ertig erhaltlich sind. Die weiteren Bauteile umfas- 
sen einen Blasen-Speicher 310 als externe Speichereinrich- 
tung, ei'he Blasen-Speicher-Schnittstelle 312 fur den Bla- 
senspeicher 310, eine Terminal-E/A-Schnittstelle 314 fur 

25 ein mit einer CRT-Anzeigeeinrichtung und einer Tastatur 
aiisgestattetes Terminal T, eine Drucker-Ausgabeschnitt- 
stelle 316 fur einen Drucker P, eine Lern-Einrichtungs-Ein- 
gabeschnittstelle 318 fur eine Lern-Einrichtung 14, die 
Sensor-Eingabe-Schnittstelle 230 fur den Sensorkopf 22 (die 

30 Sensor-Eingabe-Schnittstelle 230 erzeugt in voreingestell- 
ten Zeitabstanden eine Unterbrechung in der zweiten CPU 
301, um das Signal von dem Sensor-Controller 24 zu iibertra- 
gen), und sechs Servo-Schaltungen 320, 322, 324, 326, 328 & 
330 fur die erste bis sechste Achse. 

35 

Jede Servo-Schaltung 320 bis 330 ist vom sogenannten intel- 
.. .ligenten Typ.und.hat eine CPU. Wenn. Z.ielpositionsdaten und 
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Zielstellungsdaten fur das Werkzeug 20 von der ersten CPU 
3 00 iiber den Bus 308 iibertragen werden, steuern die Schal- 
tungen 320, 322, 324, 326, 328 & 330 entsprechend Motoren 
30, 40, 50, 60, 70 & 80 liber Motor-Ansteuerschaltungen bzw- 
5 Motor-Treiber 332, 334, 336, 338, 340 & 342 an, um die 
Spitze des Werkzeugs 20 in die Zielposition und um das 
• Werkzeug 20 oder die Hand 18 in eine Zielstellung zu bewe- 
gen. Bei der Ansteuerung iibertragen die Winkelsensoren 34, 
44, 54, 64, 74 & 84 Drehwinkel-Daten fur die entsprechenden 

10 Achsen zu den Servo-Schaltungen 320 bis 330. Die Schaltun- 
gen 320 bis 330 steuern je nach den Gegebenheiten auch die 
Bremsen 32 , 42 , 52 , 62 , 72 & 82 an, um ein Herunterf alien 
des Arms des Stellglieds 16 zu verhindern, wenn die Ener- 
giequelle der Servoschaltungen 3 20 bis 3 30 oder der Motoren 

15 30, 40, 50, 60, 70 & 80 abgeschaltet wird. 

Wie in dem Blockschaltbild in Fig. 8 dargestellt ist, um- 
faftt die Roboter-Steuereinrichtung 12 einen Standard-Weg- 
Speicher 400 zum Speichern gelernter Punktdaten PTtch als 

20 Bestandteil eines Standard-Wegs , wobei die Daten PTtch mit- 
tels der Lern-Einrichtung 14 gelernt werden; eine Interpo- 
lations-Bestimmungseinrichtung 402 zum Erzeugen von Zielpo- 
sitionsdaten PTpath fur das Werkzeug 20, um entsprechend 
den gelernten Punktdaten PTtch in dem Speicher 400 nachein- 

25 ander die Zielpositionsdaten PTpath zu erreichen, die den 
Interpolationspunkt auf dem Standard-Weg angeben; eine 
Werkstiickf orm-Naherungseinrichtung 404, um von dem Sensor 
22. erfaSte Daten Ssen bezuglich des Werkstucks W und Be- 
reichs-Mittelpunkts-Daten fur die Hand 18 zu empfangen, und 

30 zum Berechnen von Werkstuckf orm-Daten PSwall, Arbeitspunkt- 
Daten PTtool, einem Vektor L (in der Beschreibung sind 
Vektoren mit Fettdruck-Buchstaben , beispielsweise L, be- 
zeichnet; in der Zeichnung sind sie mit einem Pfeil uber 
dem Buchstaben kenntlich gemacht) von PTtool nach PSwall, 

35 und der Lange |L| des Vektors L; einen Werkstuckf orm-Spei- 
cher 406 zum Speichern von PSwall, PTtool, L und |L| ; eine 
Werkzeugpositions-Naherungseinrichtung 4 08 zum Berechnen 
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einer genaherten Werkzeugposition PTpmod-dash aus den 
Zielpositions-Daten PTpath von der Interpolations-Bestim- 
mungseinrichtung 40 2 und einer Korrektur £^PT von einer 
(nachstehend erklarten) Weg-Korrektureinrichtung 414; eine 
5 Naherungspositions-Pro jektionseinrichtung 410 zum Berechnen 
mehrerer Vektoren IL, indem PTpmod-dash auf den Vektor L im 
Werkstuckf orm-Speicher 406 projiziert wird, der die Werk- 
stuckf orm annahert; eine Pro jektions-Bestimmungseinrichtung 
412 zum Auswahlen des kurzesten Vektors IL; eine Weg-Kor- 

10 rektureinrichtung 414 zum Berechnen modif izierter Daten PT- 
mod und der Korektur /\PT aus dem kurzesten von der Projek- 
tions-Bestimmungseinrichtung 412 ausgewahlten Vektor ent- 
sprechenden Werkstiick-Punkt-Daten PSlwall und aus den Ziel- 
positions-Daten PTpath der Interpol at ions-Best immungs- 

15 einrichtung 402; und eine Roboter-Steuereinrichtung 416 zum 
Positionieren des Werkzeugs 20 entsprechend den modifizier- 
ten Daten PTmod. 

Fig. 9 stellt die Beziehungen zwischen dem Werkstuck W, der 
20 Hand 18 , dem Werkzeug 20, dem Sensor 22 und den gerade ein- 
gefuhrten Werten dar. Mittels der Roboter-Steuereinrichtung 
12 verhalt der Roboter 10 sich wie folgt. 

(1) Die Werkstuckf orm-Daten PSwall und der genaherte Vektor 
25 L von der Werkstuckf orm-Naherungseinrichtung 404 werden in 

dem Werkstuckf orm-Speicher 406 gespeichert. 

(2) Die Werkzeugpositidns-Naherungseinrichtung 408 berech- 
net die genaherte Werkzeugposition PTpmod-dash aus den 

30 Zielpositionsdaten PTpath und der zuvor von der Weg-Korrek- 
tureinrichtung 414 erhaltenen Korrektur A^T. 

(3) Die Naherungspositions-Pro jektionseinrichtung 410 pro- 
jiziert die genaherte Werkzeugposition PTpmod-dash auf die 

3 5 genaherten Vektoren und berechnet die Differenz zwischen 
der Lange des genaherten Vektors L und der Entfernung zu 
dem Pro jektionspunkt. 



(4) 'Die Pro jektions-Bestimmungeinrichtung 412 wahlt die 
Werkstiick-Punktdaten PSlwall aus, die die geringste Diffe- 
renz zwischen der Vektorlange und der Entfernung zu dem 
Pro jektionspunkt auf weisen . 

(5) Die Weg-Korrektureinrichtung 414 berechnet die Korrek- 
tur /±PT aus den Werkstuck-Punktdaten PSlwall und erzeugt 
modif izierte Daten PTmod aus PSlwall und den Zielpo- 
sitionsdaten PTpath. 

(6) Die Roboter-Steuereinrichtung 416 positioniert die Hand 
18 entsprechend den modif izierten Daten PTmod. 

Die Roboter-Steuereinrichtung 416 ist mit Bezug auf die Fi- 
guren 10 und 11 erklart. Bevor eine besondere Aufgabe mit 
dem Roboter 10 begonnen wird, benutzt ein Bediener die 
Lern-Einrichtung 14, damit der Roboter 10 lernt, welchen 
Arbeitspunkten 21 (vergleiche Fig. 3) auf dem Werkstuck W 
das Werkzeug 20 folgen soil und welche Stellung das Werk- 
zeug 20 vor dem Erreichen jedes Arbeitspunkts 21 einnehmen 
soil. Beispielsweise ist ein Abstandhalter einer gewissen 
Lange an der Spitze des Laserwerkzeugs 20 befestigt. Die 
Lange des Abstandhalters ist zunachst so bestimmt, da£ ein 
fur die spezielle Aufgabe zweckmaSiger Abstand zwischen der 
Spitze des Werkzeugs- 20 und der Werkstiick-Oberf lache vor- 
handen ist. Der Bediener bewegt die Hand 18 mit der Spitze 
des Abstandhalters , wodurch ein gewiinschter Weg auf der 
Werkstuck-Oberf lache verfolgt wird, oder manchmal weg von 
der Oberf lache, wodurch die Position und Stellung des Werk- 
zeugs an jedem einzelnen Arbeitspunkt 21 bestimmt wird 
(Fig. 3). 

Die Position jedes einzelnen Arbeitspunkts 21 mit Bezug auf 
einen vorbestimmten Bezugspunkt des Roboters 10, sowie die 
Stellung des Werkzeugs 20 an dem Arbeitspunkt 21 werden in 
Form einer 4x4 Matrix in dem Standard-Weg-Speicher 400 ge- 



speichert. Beispielsweise werden gelernte Daten an einem m- 
ten Lern-Punkt (Arbeitspunkt ) reprasentiert durch 



NX 


Ox 


Ax 


X 


Ny 


Oy 


Ay 


Y 


Nz 


Oz 


AZ 


Z 


0 


0 


0 


1_ 



wobei Nx, Ny und Nz x-y-z-Komponenten eines Normalenvektors 
sind; Ox , Oy und Oz x-y-z-Komponenten eines Orientierungs- 
vektors sind; Ax, Ay und Az x-y-z-Komponenten eines Annahe- 
rungs-Vektors sind; und X, Y und Z x-y-z-Komponenten eines 
Positionsvektors des m-ten Lern-Punkts sind. 



Jede Komponente der Vektoren wird von einem Koordinatensy- 
stem O-XYZ mit dem Ursprung O an dem vorbestimmten Bezugs- 
punkt des Stellglieds 16 dargestellt. Der Normalenvektor, 
der Orientierungsvektor und der Annaherungs-Vektor stehen 
zueinander senkrecht. 



Nach dem Lern-Vorgang beginnt der Roboter 10 mit der spe- 
ziellen Aufgabe. Die Grundf unktionen des Roboters 10 sind 
mit Bezug auf Fig. 10 erklart. 

Zuerst empf angt die Interpolations-Bestimmungeinrichtung 
402 einen Lern-Punkt PTtch ( Positionsdaten ) aus dem Stan- 
dard-Weg-Speicher 400 in dem Blasen-Speicher 310 und be- 
rechnet dann Positions-und Stellungsdaten PTpath (Ziel- 
positionsdaten) , die dann in einem Interpolations-Speicher 
420 in dem RAM 304 gespeichert werden. Auf das Empfangen 
der Zieldaten PTpath von dem Interpolations-Speicher 420 
hin, wendet die Weg-Korrektureinrichtung ^414 in einem Ziel- 
Of f set-Addierer 414d eine Korrektur APT und eine Ziel-Ver- 
schiebung bzw. einen Ziel-Offset Ofs auf die Zieldaten PT- 
path an, urn modifizierte Daten PTmod gemaB der folgenden 
Berechnung zu erhalten: 

PTpmod = PTpath - APT . . • (4) 
PTmod = PTpmod • Ofs ( 5 ) 
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Der Ziel-Offset Ofs ist eine Position des Arbeitspunkts 21, 
die durch ein Koordinatensystem , dessen Ursprung in der 
Spitze des Werkzeugs 20 liegt, dargestellt wird, und stellt 
eine relative Position des Arbeitspunkts 21 mit Bezug auf 
5 die Werkzeugspitze dar. Die Korrektur /^PT wird, wie nach- 
stehend beschrieben, in der zweiten CPU 301 berechnet. In 
- diesem Fall stehen PTpath, APT, PTpmod, Ofs und PTmod in 
den in Fig. 9 gezeigten Beziehungen zueinander. Dann werden 
die modif izierten Daten PTmod einer inversen kinematischen 
10 Umwandlungsschaltung 416a der Roboter-Steuereinrichtung 416 
(Fig. 10) zugefiihrt, die PTmod decodiert und Drehwinkel 
Ghost fur die sechs Achsen erzeugt. Diese Funktionen werden 
in der ersten CPU 300 ausgefuhrt. 

15 Die sechs Winkeldaten Ghost werden den entsprechenden 
Servo-Schaltungen 320 bis 330 zugefiihrt, die iiber die Trei- 
ber 332 bis 342 die Motoren 30, 40, 50, 60, 70 & 80 ansteu- 
ern, um den Arbeitspunkt 21 des Werkzeugs 20 zu dem durch 
PTmod dargestellten modif izierten Zielpunkt zu bewegen. 

20 

Die Berechnung der Korrektur J^PT mit der zweiten CPU 301 
ist mit Bezug auf die Figuren 9 und 10 erklart. Zuerst emp- 
fangt die Werkstiickf orm-Naherungseinrichtung 404 Bereichs- 
Mittelpunkts-Daten ftir das Werkzeug 20 und die relative Po- 

25 sition des Sensors 22 zu dem Werkstuck W darstellende er- 
faBte Daten Ssen. Die Bereichs-Mittelpunkts-Daten werden 
aus einer kinematischen Umwandlungsschaltung bzw. Transfor- 
mationsschaltung 4 22 erhalten, indem der Drehwinkel Gene 
der sechs Achsen von den Winkelsensoren 34, 44, 54, 64, 74 

30 & 84 umgewandelt wird. Die Transformation erfolgt entspre- 
chend der folgenden Berechnung. ~ 

Bereichs-Mittelpunkts-Daten = j\_ [Gene] ... (6) 

wobei W A U eine kinematische Transformation und [Gene] ein 
Winkelvektor ist. 



35 
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Dann ' berechnet die Werkstuckf orm-Naherungseinrichtung 404 
aus den Bereichs-Mittelpunkts-Daten wie folgt Sensor-End- 
Daten PS und tatsachliche Positions-Daten PTenc: 

PS = (Bereichs-Mittelpunkts-Daten) • ^f^g ...(7) 
5 PTenc = (Bereichs-Mittelpunkts-Daten) • 7T f ^ T ...(8) 

wobei 7r f ^ s eine die Position des Sensors 22 mit Bezug auf 
- das Bereichs-Ende des Werkzeugs 20 darstellende Positions- 
und Stellungsmatrix ist und 7Tf^ T eine die Position des Ar- 
beitspunkts 21 mit Bezug auf das Bereichs-Ende darstellende 
10 Positions- und Stellungsmatrix ist. 

Die Werkstuckf orm-Naherungseinrichtung 404 empfangt von dem 
Sensor-Controller 24 die erfaSten Daten Ssen, die die rela- 
tive Position des Sensors 22 zu dem Werkstiick W und die 

15 Form des Werkstiicks W am Erf assungspunkt wiedergeben, und 
wandelt diese Daten Ssen dann unter Verwendung der Sensor- 
End-Daten PS in Werkstuckf orm-Daten PSwall urn, die die Po- 
sition und Stellung des Werkstiicks W mit Bezug auf den Be- 
zugspunkt O des Roboters 10 darstellen. 

20 PSwall = PS- Ssen ...(9). 

Die erfaBten Daten Ssen konnen ein aus innerhalb eines sehr 
kurzen Abtastintervalls erhaltenen mehreren Proben gebilde- 
ter Mittelwert sein. Die Daten PSwall werden zwischenzeit- 
25 lich. in dem Werkstuckf orm-Speicher 406 gespeichert* 

Die Werkstuckf orm-Naherungseinrichtung 404 berechnet aus 
den tatsachlichen Positionsdaten PTenc und dem Ziel-Offset 
Ofs entsprechend der folgenden Formel Werkstuckpunkt-Daten 
30 PTtool, urn Positionsanteile der Werkstuckpunkt-Daten PTtool 
in dem Speicher 406 zu speichern. 

PTtool = PTenc- Ofs"" 1 ...(10). 

Hier wird der Ziel-Offset Ofs gemaB externer, dem Roboter 
35 10 zugefuhrten Inf ormationen (beispielsweise Bearbeitungs- 
bedingungen) oder gemaB in dem Steuerprogramm des Roboters 
- ID. jarzeugter Bef ehle . verandert . 
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Unter Verwendung der x-y-z-Komponenten (Xwall, Ywall, 
Zwall) der Werkstuckf orm-Daten PSwall und der x-y-z-Kompo- 
nenten (Xtool, Ytool, Ztool) der Werkstiickpunkt-Daten PT- 
tool ist ein von PTtool zu PSwall reichender 'Vektor L defi- 
5 niert als 

L = (Xwall, Ywall, Zwall) - (Xtool, Ytool, Ztool) 

. . . (11) . 

Dieser Vektor L und seine Lange |L| werden dem Werkstiick- 
10 f orm-Speicher 406 zugefuhrt. 

Eine Gruppe von in der Werkstuckf orm-Naherungseinrichtung 
404 synchron erhaltenen Daten wird in dem Speicher 406, wie 
in Fig. 11 dargestellt , gespeichert. Wenn alle dieser syn- 
15 chronen Daten vorbereitet sind, inkrementiert ein Zwischen- 
speicher-Zahler 424 den Zahler urn eins. In Fig. 11 bezeich- 
nen KH1 und KHl-n die derzeitige beziehungsweise die unmit- 
telbar zuvor erhaltene Probe aus n Proben in der Zeitfolge. 

20 Die Werkzeugpositions-Naherungseinrichtung 408 nahert unter 
Verwendung der Zieldaten PTpath und der von einer Kor- 
rektur-Berechnungseinrichtung 414a der Weg-Korrekturein- 
richtung 414 bei einem letzten Korrekturvorgang berechneten 
Korrektur /\ PT eine Werkzeug-Zielposition PTpmod-dash an. 

25 Die Naherung ist definiert als: 

PTpmod-dash = PTpath . ^PT(KH1-1 ) ...(12) 
wobei KH1-1 eine unmittelbar zuvor erhaltene Probe bezeich- 
netl . 

30 Die Anderung der Arbeitsgeschwindigkeit ist im allgemeinen 
durch den Standard-Weg bestimxnt. Genauer, die Werkzeug- 
Zielposition PTpmod-dash wird aus der Geschwindigkeit be- 
rechnet, die durch die Zielpositionsdaten PTpath sowie 
durch die Bewegung des Werkzeugs bis zur letzten Korrektur 

35 ^PT(KHl-l) bestimmt ist. Zudem werden die geeignetsten 
Werkstuckf orm-Daten PSwall aus mehreren Werkstuckf orm-Daten 
ausgewahlt, so daS sie der Werkzeug-Zielposition PTpmod- 
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dash am nachsten kommen. Deshalb kann eine geeignete 
Zielposition entsprechend der sich verandernden Geschwin- 
digkeit des Roboters 10 bestimmt werden. 

5 Eine Vektor-Berechnungseinrichtung 410a der Pro jektionsein- 
richtung 410 berechnet unter Verwendung der x-y-z-Komponen- 
ten (Xpmod-dash, Ypmod-dash, Zpmod-dash) der Werkzeug-Ziel- 
position PTpmod-dash und der x-y-z-Komponenten 
(Xtool , Ytool , Ztool) der Werkstuckpunkt-Daten PTtool einen 
10 von PTtool nach PTpmod-dash reichenden Vektor I. 

I = (Xpmod-dash, Ypmod-dash, Zpmod-dash) - 

( Xtool , Ytool , Ztool ) ...(13) 

Die folgende Verarbeitung berechnet den PTpmod-dash am 
15 nachsten liegenden Wert PSlwall. 

Da es lange dauert, die Positionsbeziehungen fur alle Werk- 
stiickf orm-Daten PSwall zu berechnen, wird zuerst das abge- 
schlossene Intervalll [a,b] eingestellt, das ein Bereich 

20 eines zu vergleichenden Zeitintervalls ist- Ein Anfangswert 
von a ist KHl-n, das das n-te Zeitintervall vor dem derzei- 
tigen Zeitintervall KH1 ist, wahrend ein Anfangswert von b 
das derzeitige Zeitintervall KH1 ist. n wird entsprechend 
Bearbeitungsbedingungen eingestellt, wie beispielsweise der 

25 Bearbeitungsgeschwindigkeit und dem Abstand zwischen dem 
Werkzeug und dem Sensor. 

Eine Winkel-Berechnungseinrichtung 410b berechnet unter 
Verwendung der Formel (15) aus einem aus dem Speicher 406 

30 ausgelesenen Vektor L im Zeitintervall a, |L(a) | und dem 
Vektor I einen Winkel cosG zwischen I und L(a). 

cosG = (L(a)-I) / ( |L(a) | • |I| ) ...(15) 
wobei der Vektor L als L(a) bezeichnet ist, urn ibn von Da- 
ten aus. anderen Zeitintervallen zu unterscheiden . Andere 

35 Variable konnen ahnlich bezeichnet werden. 



- 23 - 

Eine Berechnungseinrichtung 410c zur Berechnung trigonome- 

trischer Funktionen berechnet eine Lange |lL(a)| eines Vek- 

tors IL(a), der eine Projektion von I auf L(a) ist, unter 
Verwendung von Formel (16) aus I und dem gemaB Formel (15) 
5 berechneten Wert cose. 

|lL(a) | - |I| -cos0 . . . (16) 

Eine Dif f erenz-Berechnungseinrichtung 410d berechnet unter 
Verwendung von Formel (17) die Differenz zwischen dem gemaS 
10 Formel (16) berechneten Wert |lL(a)| und |L(a) | von L(a) . 

f (a) = |L(a) | - |lL(a) | . . . (17) 

Unter Verwendung der im Speicher 406 gespeicherten Daten 
fur das Zeitintervall b wird als nachstes f(b) berechnet, 
15 indem die von der Vektor-Berechnungseinrichtung 410a bis 
zur Dif f erenz-Berechnungseinrichtung 410d ausgefuhrten 
Funktionen wiederholt werden. 

Dann werden die von der Pro jektionseinrichtung 410 berech- 
20 neten Werte f(a) und f(b) einem Dif f erenz-Vergleicher 412a 
der Bestimmungseinrichtung 412 zugefuhrt und mit den in 
Formel (17b) genannten Bedingungen verglichen. 
f(a) < |L| 

f (b) > 0 ... (17b) 

25 

Wenn Formel (17b) nicht erfullt ist, wird die Verarbeitung 
von einem Anomalie-Prozessor 426 fortgesetzt, und der von 
der Korrektur-Berechnungseinrichtung 414a fur die vorherige 
Wegkorrektur berechnete Wert ^PT(KHl-l) wird als ^PT zu 
30 einer Berechnungseinrichtung 414b zum Berechnen eines Weg- 
Anzeigewerts ubertragen . 

Wenn Formel (17b) erfullt ist, vergleicht eine Uberpru- 
f ungseinrichtung 412b, die ein abgeschlossenes Intervall 
35 uberpriift, die abgeschlossenen Zeitintervalle a und b unter 
Verwendung der Formel (18) 

b - a < 1 .... (18) 
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Wenn Formel 18 erfullt ist, wird PSwall gemaB Fig. 11 eines 
Zeitintervalls init dem kleineren Wert von f (x) fur die Zei- 
t interval le a und b zu dem zur Weg-Korrektur verwendeten 
PSlwall gesetzt. 

5 

Wenn Formel (18) andererseits nicht erfullt ist, berechnet 
eine einen Mittelpunkt des abgeschlossenen Intervalls be- 
rechnende Berechnungseinrichtung 412c den Mittelpunkt c 
zwischen den Zeitintervallen a und b. 

10 

Dann wird ein Lese-Signal zu dem Speicher 406 iibertragen, 
so daJJ f(c) fur den Mittelpunkt c erhalten wird, indem die 
von der Berechnungseinrichtung 410a bis zur Berechnungsein- 
richtung 410d der Pro jektionseinrichtung 410 ausgefiihrten 
15 Funktionen wiederholt werden. 

Ein Dif f erenz-Vergleicher (2) 412d untersucht f(c) auf den 
Mittelpunkt c hin . Wenn f(c) > 0 ist, wird b durch c er- 
setzt; wenn f(c) < 0 ist, wird a durch c ersetzt. All diese 
20 Verarbeitungen werden zum Erhalten des zur Weg-Korrektur 
verwendeten PSlwall wiederholt. Das zum Zeitintervall KH1 
ausgewahlte PSlwall kann auch wie folgt erhalten werden. 

Wenn ein Wert KH2 existiert, fur den |L(KH2)| 
25 |IL(KH2 |KH1) | am kleinsten ist, kann PSlwall bestimmt wer- 

den, indem eine Interpolation auf der Grundlage der drei 
Werkstiickf orm-Daten PSwall ( KH2-1 ) , PSwall(KH2) , PS- 
wall (KH2+1) durchgefiihrt wird. Beispielsweise werden ledig- 
lich die Positionsvektoren mittels der folgenden Interpola- 
3 0 tion berechnet. 

al = ( | PSwall (KH2-1) - PTpath ( KH1 ) | ) ~ x ...(19) 
a2 = ( |PSwall(KH2) - PTpath ( KH1 ) | ) " 1 ...(20) 
a3 = ( | PSwall (KH2+1) - PTpath ( KH1 ) | i" 1 ...(21) 
wobei PSwall ein Positionsvektor von PSwall und PTpath ein 
35 Positionsvektor von PTpath ist. 
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Wenn die folgenden Gleichungen 
Jl = al/(al+o:2+a3 ) , 
JL2 =. a2/(al+a2+a3 ) , und 
±3 = a3/(al+a2+a3) , 
erfullt sind, wird ein Positionsvektor PSlwall von psiwall 
unter Verwendung der folgenden Formel erhalten. 

PSlwall (KH1) = Xl.PSwall(KH2-l) + £2 -PSwall (KH2 ) + 

j3.PSwall(KH2+l) ...(22) 

PSlwall wird ausgewahlt, da das Interval 1 der Ausgabe der 
Zieldaten von der Roboter-Steuereinrichtung 12 an die Ser- 
vo-schaltungen 332 bis 342 langer ist als das Intervall der 
Eingabe der Positions- und Form-Daten des Arbeitspunkts von 
dem Sensor-Controller 24, oder da die Arbeitsgeschwindig- 
keit des Roboters 10 sich erhoht. Anders ausgedriickt, der 
Speicher 406 speichert im allgemeinen mehrere Werksttick- 
form-Daten. Deshalb sollten optimale Daten aus einer groBen 
Auswahl von Daten ausgewahlt werden. 

Wenn die Roboter-Steuereinrichtung 12 derart aufgebaut ist, 
werden, selbst wenn sich die Arbeitsgeschwindigkeit des Ro- 
boters andert, korrekte Zielpositionen bestimmt. Wenn bei- 
spielsweise die von dem Sensor-Controller 24 erzeugte Da- 
tenanzahl annahernd gleich der von der Roboter- 
Steuereinrichtung 12 erzeugten Datenanzahl ist, und sich 
die Arbeitsgeschwindigkeit des Roboters 10 sich wahrend des 
Betriebs erhoht, konnen Inf ormationen iiber das Werkstiick w 
an dem gewunschten Punkt fehlen. Da die Roboter-Steuerdaten 
bei diesem Ausf iihrungsbeispiel jedoch durch Interpolieren 
erfaBter Daten auf mangelnde bzw. fehlende Punkte erzeugt 
werden, wird dieses Problem nicht auftreterT. 

Wenn die aus dem Speicher 406 ausgewahlten Daten PSlwall 
erzeugt werden, wird die Differenz R-ofs zwischen den Daten 
PSlwall und den zuvor in dem Speicher 420 abgelegten Daten 
PTpath wie folgt erhalten 

. R-ofs = PTpath -1 . PSlwall ...(23) 
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Bei elner Korrektur-Auswahleinrichtung 414c wird unter Ver- 
wendung der Daten R-ofs wie folgt eine Matrix APT erhal- 
ten, die von Null verschiedene Elemente lediglich an den 
Stellen bzw. in den Zellen aufweist, die den von dem Sensor 
22 erfaBten Stellen entsprechen . 
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Wenn beispielsweise 

(1) lediglich die Entfernung der Z-Komponente im Werkzeug- 
Koordinatensystem erfaBt wird; 



A PT = 



0 
1 
0 
0 



0 
0 

1 

0 



(24) 



15 



20 



(2) lediglich die Entfernung der Y-Komponente im Werkzeug- 
Koordinatensystem erfaBt wird; 



Apt = 



0 

1 

0 
0 



0 
0 

1 

0 



(25) 



25 
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(3) wenn lediglich die Werkzeug-Stellung und lediglich die 
Entfernung der Z-Komponente erfaBt werden; 

R-ofs = PTpath"" 1 . PSlwall ...(26) und 



APT = 



R-ofs 



(27) 



Die so erhaltene Korrektur /\PT wird der Anomalie-Erf as- 
sungseinrichtung 4 28 zugefuhrt und mit dem voreingestellten 
Wert £ verglichen. 
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Wenn der Betrag |A PT I von /\PT groBer als B ist, wird eine 
Anomalie-Verarbeitung (beispielsweise eine Notabschaltung 



des Roboterbetriebs) durchgef uhrt , da der Roboter 10 die 
Zielposition verfehlen konnte. 

Wenn andererseits \&PT\ kleiner als 8'ist, verwendet die 
Berechnungseinrichtung 414b /\PT, um gemaB Formel (4) 
PTpmod zu erhalten. 

Wenn die Stellungs-Komponente in den Korrektur-Komponenten 
von ^PT enthalten ist und eine Bewegung lang ist, konnen 
Vibrationen auftreten, so da£ die folgenden Verarbeitungen 
durchgef tihrt werden. 

(1) Ein Hauptantriebswellen-Drehwinkel 9 wird aus den bei- 
den Matrizen von PTiriod(KHl) und PTmod(KHl-l) erhalten. Wenn 
dieser Winkel e groBer als Winkel a ist, irtit dem der Robo- 
ter 10 bei der Maximalgeschwindigkeit betreibbar ist, wird 
e durch a zum Erzeugen neuer Daten PTmod(KHl) ersetzt. 

(2) Wenn der Hauptantriebswellen-Drehwinkel 0 beispiels- 
weise kleiner als 2° ist, wird die Stellung nicht korri- 
giert . 

Diese Verarbeitungen der ersten CPU 3 00 und der zweiten CPU 
301 sind in den FluBdiagrammen in Fig.. 13 und 14 darge- 
stellt. 

Die Roboter-Steuereinrichtung 12 enthalt bei diesem Ausfuh- 
rungsbeispiel die beiden in Fig. 7 gezeigten CPU's 300 und 
301, die synchron zueinander zusammenarbeiten . Fig. 13 ist 
ein FluSdiagranun, das den Funktionsablauf in der ersten CPU 
300 zeigt; Fig. 14 ist ein FluSdiagramm fur die zweite CPU 
301. 

Wenn der Roboter 10 den Betrieb aufnimmt, f tihrt die erste. 
CPU 300 sequentiell die folgenden Verarbeitungsschritte 
aus . 
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Schritt 500: PTpath zum Zeitintervall KH1 wird durch Inter- 
polieren der Positionsdaten PTtch auf den im Speicher 400 
gespeicherten Standard-Weg berechnet. 

5 Schritt 50 2: PTpath wird der zweiten CPU 3 01 zugefuhrt, um 
die modif izierten Daten PTmod von der zweiten CPU 301 anzu- 
fordern. 

Schritt 504: PTmod wird von der zweiten CPU 301 empfangen. 

10 

Schritt 506: PTmod wird in Ziel-Drehwinkel Ghost fur jede 
Achse dekodiert. 

Schritt 508: Die Wi'nkel ehost werden den Servo-Schaltungen 
15 320 bis 330 der entsprechenden Achsen zugefuhrt. 

Schritt 510: KH1 wird um eins inkrementiert , um die 
Schritte 500 bis 510 fur das nachste Zeitintervall zu 
wiederholen . 

20 

Die zweite CPU 301 fiihrt die folgenden Verarbeitungs- 
schritte aus . Schritte 602 und 604, und Schritte 610 bis 
638 werden aufgrund einer Multitasking-Verarbeitung paral- 
lel ausgefiihrt. Die Schritte 602 und 604 werden in einem 
25 Zeitzyklus des Sensor-Controllers 24 ausgefiihrt, wahrend 
die Schritte 610 bis 638 in einem Zeitzyklus der Roboter- 
Steuereinrichtung 12 ausgefiihrt werden. 

Schritt 600: Die zweite CPU-Karte wird initialisiert . 

30 

Schritt 602: Die Positions- und Form-Daten Ssen des Abtast- 
punkts werden von dem Sensor-Controller 24 empfangen. 

Schritt 604: Drehwinkel-Daten Gene fur jede einzelne Achse 
35 werden von den Winkelsensoren 34, 44, 54, 64, 74 & 84 zur 
gleichen Zeit empfangen, zu der der Sensor 22 mit dem Abta- 
sten beginnt. 



Schritt 610: PTpath wird von der ersten CPU 300 empfangen. 

Schritt 612: Die tatsachlichen Daten PTenc des Ar- 
beitspunkts, Positions-Komponenten von PTtool , PSwall und 
von dem sich von PTtool bis PSwall erstreckenden Vektor L, 
sowie |L| werden entsprechend den vorstehenden Formeln er- 
halten und dann in einem KH1 entsprechenden Speicherbereich 
des Speichers 406 gespeichert. 

Schritt 614: PTmod-dash wird aus PTpath und der in den vor- 
stehenden Formeln zur vorherigen Weg-Korrektur verwendeten 
Korrektur /\PT erhalten. 

Schritt 616: Ein Daten-Such-Intervall [a, b] zum Auswahlen 
von PSlwall aus dem Speicher 406 wird erhalten. Wie vorste- 
hend beschrieben, sind die Anf angswerte : a = KHl-n und b = 
KH1 . 

Schritt 618: PTtool wird aus dem Speicher 406 ausgelesen 
und der sich von PTtool zu PTpmod-dash erstreckende Vektor 
I und dessen Lange | I | werden entsprechend den vorstehenden 
Formeln erhalten. Ferner werden L(a) und L(b) aus dem Spei- 
cher 406 ausgelesen, und der durch I und L(a), L(b) be- 
stimmte cose wird entsprechend den vorstehenden Formeln er- 
halten . 

Dann werden die Vektoren IL(a) und IL(b) , die eine Projek- 
tion von I auf L(a), L(b) sind, und ihre Langen |lL(a)| und 
|lL(b)| entsprechend den vorstehenden Formeln erhalten. 

Schritt 6 20: Wenn im Daten-Such-Intervall ~[ a , b] 
f (a) < |l| , oder 
f(b) > 0 ist, 

schreitet die Steuerung zu Schritt 6 22 fort, bei dem die 
Anomalie-Verarbeitung ausgefuhrt wird; andernfalls schrei- 
tet die Steuerung zu Schritt 624 fort. 
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Schritt 622: Der zuvor berechnete Wert /\PTf KH1-1 ) ver- 
bleibt als APT fur die derzeitige Verarbeitung, und die 
Steuerung schreitet zu Schritt 636 fort. 

5 Schritt 624: Wenn die PTpmod-dash am nachsten gelegenen 
Werkstuckf orm-Daten gefunden wurden, schreitet die Steue- 
• rung zu Schritt 632 fort, andernfalls geht sie zu Schritt 
626 uber. Die Testbedingung daftir, b - a < 1, ist erftillt, 
wenn beide Endpunkte des Such-Intervalls am selben Punkt 
10 sind, oder wenn sie aneinandergrenzen . 

Schritt 626: Das Einschlu3-Verf ahren wird verwendet, urn 
schnell innerhalb des Such-Intervalls zu iiberprufen.. Auf 
diese Weise wird der Mittelpunkt des Daten-Such-Intervalls 
15 [a, b] gefunden, 

Schritt 628: f (c) wird im Mittelpunkt c erhalten. 

Schritt 630: Wenn f(c) > 0 ist, wird c durch ein neues b 
20 ersetzt. Wenn f(c) < 0 ist, wird c durch ein neues a er- 
setzt. Dann kehrt die Steuerung. zu Schritt 624 zuruck. 

Schritt 632: PSwall wird fur das ausgewahlte Zeitintervall 
aus dem Speicher 406 ausgelesen, und dieses PSwall wird 
25 PSlwall zugewiesen. 

Schritt 634: Die Differenz R-ofs zwischen dem ausgewahlten 
PSlwall und PTpath wird unter Verwendung der vorstehenden 
Formeln bestimmt. Unter Verwendung von R-ofs und der Kor- 
30 rektur-Auswahleinrichtung 414c wird unter Verwendung der 
vorstehenden Formeln die Korrektur /\PT bestimmt, urn mit 
der. Anomalie-Erf assungseinrichtung 428 auf das Vorhanden- 
sein von Anomalien hin zu iiberprufen. 
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Schritt 636: Die modif izierten Daten PTmo£ werden aus PT- 
path, ^PT und einem Ziel-Offset ofs berechnet. 
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Schritt 638: PTmod wird zur ersten CPU 300 ubertragen und 
die Steuerung kehrt zu Schritt 610 zuriick. 

Der Roboter 10 arbeitet, wahrend der Punkt auf dem Werk- 
5 stuck fur die nachste Bearbeitung erfaBt wird, indem die 
vorstehende Verarbeitung wiederholt wird. 

Diese Ausfiihrung scheint einen Speicher unbegrenzter Spei- 
cherkapazitat .zum Speichern der Position und Stellung im 
10 Arbeitspunkt zu erfordern. Tatsachlich tritt dieses Problem 
jedoch nicht auf, da die Daten in einem Ring-Zwischenspei- 
cher abgelegt sind. 

Bei dem dem Stand der Technik gemaBen Roboter wird der Ro- 
15 boter betrieben, indem in der Interpolationspunkt- 
Erzeugiingseinrichtung interpolierte Zieldaten direkt der 
Roboter-Steuereinrichtung zugefuhrt werden. 

Bei diesem Ausf iihrungsbeispiel dagegen werden Arbeitspunkt- 
20 Daten in der Korrektureinrichtung auf der Grundlage eirfaB- 
ter Inf ormationen revidiert, urn einen neuen Weg zum Steuern 
des Roboters zu erhalten. 

Das vorliegende Ausf iihrungsbeispiel der vorstehend be- 
25 schriebenen Zusammensetzung hat die folgenden Wirkungen. 

(1) Der Roboter kann Hochgeschwindigkeits-Arbeiten aus- 
fuhren, da der Zielpunkt im voraus erfaBt wird. Insbe- 
sondere betragt die Arbeitsgeschwindigkeit eines mit einem 
30 dem Stand der Technik gemaBen Sensor gesteuerten Roboters 
hochstens 50 bis 100 mm/sec, wahrend ein diese Erfindung 
verwendender Roboter eine Arbeitsgeschwindigkeit von 500 
mm/sec hat. 

35 (2) Der Roboter weicht nicht vom Weg ab, da er sich nicht 
auf die von dem Sensor 22 erfaBten Inf ormationen verlaBt, 
sondern auch auf. den Lern-Punkt. 
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(3) Eine genaue Steuerung wird erreicht, da der Roboter auf 
der Grundlage einer Reihe von Zielpunkten gesteuert wird. 
Selbst wenn beispielsweise eine abrupte Anderung zwischen 
dem gegenwartigen Arbeitspunkt und dem gegenwartigen Erfas- 

5 sungspunkt existiert, sind die Zieldaten dieses Teils be- 
reits im Speicher gespeichert, sodaB eine zweckmaBige Spur 
auf dem Werkstiick verfolgt wird. 

(4) Hochgenaue Funktion wird erreicht. Anderungen der Ge- 
schwindigkeit sind im allgemeinen durch den Standard-Weg 
bestimmt. Mit dieser Erfindung wird der Standard-Weg se- 
quentiell abgetastet, um Anderungen der Geschwindigkeit so- 
fort zu erkennen und um auf diese Anderungen flexibel anzu- 
sprechen. 

(5) Da die Inf ormationen von dem Sensor 22 beziiglich der 
Position und Stellung von einer Matrix dargestellt werden , 
kann die vorliegende Erfindung auf ein-, zwei- oder dreidi- 
mensionale Korrekturf unktionen angewendet werden. 

Nun wird ein zweites Ausf uhrungsbeispiel der vorliegenden 
Erfindung erklart. Bei diesem Ausf uhrungsbeispiel wird der 
Roboter 10 von einer Roboter-Steuereinrichtung mit von 
denen des ersten Ausf uhrungsbeispiels verschiedenen Verar- 
beitungsschritten gesteuert. Der Roboter 10 selbst ist der 
selbe wie der bei dem ersten Ausf uhrungsbeispiel verwen- 
dete . 

Wie im Blockschaltbild in Fig. 15 gezeigt, enthalt die Ro- 
30 boter-Steuereinrichtung 12 dieses Ausf uhrungsbeispiels 
einen Standard-Weg-Speicher 700 zum vorherigen Speichern 
von bei der Lern-Funktion unter Verwendung der Lern-Ein- 
richtung 14 gelernten Positionsdaten PTtch als ein Stan- 
dard-Weg ; eine Interpolations-Bestimmungseinrichtung 702 
35 zum Bestimmen der Ziel-Daten PTpath (das heifct, den Inter- 
polationspunkt auf dem Standard-Weg , zu dem das Werkzeug 2 0 
sich bewegt)__auf der .Grundlage der im Speicher 700 gespei- 
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cherten Positionsdaten ; eine Werkstiickf orm-Naherungsein- 
richtung 704 zum Eingeben erfaBter Daten Ssen fur ein Werk- 
stuck W und ' der Bereichs-Mittelpunkts-Daten fur die Hand 
18, und zum Berechnen der Werkstiickf orm-Daten PSwall; einen 
5 . Werkstuckform-Speicher 706 zum Speichern der Werkstiickf orm- 
Daten PSwall; eine Naherungsposition-Pro jektionseinrichtung 
708 zum Berechnen einer Vielzahl von Vektoren IL, die Pro- 
jektionen von im Speicher 706 gespeicherten Daten PSwall 
auf den Vektor L sind, der vom Startpunkt des Lernens bis 

10 zu PTpath reicht; eine Pro jektions-Bestimmungseinrichtung 
710 zum Auswahlen des ktirzesten der Vektoren IL; eine Weg- 
Korrektureinrichtung 712 zum Berechnen von PTmod und PT 
aus den dem ausgewahlten Vektor entsprechenden Daten 
PSlwall und den von der Interpolations-Bestimmungseinrich- 

15 tung 702 bestimmten Daten PTpath; und eine Roboter-Steuer- 
einrichtung 714 zum Bewegen des Werkzeugs 20 zu der von der 
Korrektureinrichtung 712 berechneten Position von PTmod, 
Die Beziehungen zwischen dem Werkstuck W, der Hand 18, dem 
Werkzeug 20, dem Sensor 22 und den entsprechenden Betragen 

20 ist ebenfalls in Fig, 9 dargestellt. 

Die Roboter-Steuereinrichtung 12 dieses zweiten Ausfuh- 
rungsbeispiels arbeitet wie folgt. 

25 (l) Der Speicher 706 speichert Werkstuckpunkt-Daten PSwall 
von der Werkstiickf orm-Naherungseinrichtung 704. 

(2) In der Pro jektionseinrichtung 708 werden Werk- 
stuckpunkt-Daten auf den Standard-Weg projiziert, und die 
30 Differenz der Entfernung zwischen den projizierten Punkten 
und den Zieldaten wird erhalten. 
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(3) In der Pro jektions-Bestimmungseinrichtung 710 wird ein 
Wert fur PSlwall mit der minimalen Differenz der Entfernung 
ausgewahlt . 
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(4) In der Korrektureinrichtung 712 wird j\VT aus den aus- 
gewahlten Daten PSlwall erhalten, und aus PTpath und PT 
wird ein neuer Wert PTmod berechnet. 

5 (5) In der Roboter-Steuereinrichtung 714 wird die Hand 18 
auf der. Grundlage des berechneten PTmod gesteuert. 

Zuerst wird PTtch aus dem Speicher 700 in dem Blasen-Spei- 
cher 310 von der Interpolations-Bestimmungseinrichtung 702 
10 interpoliert, urn PTpath fur das Werkzeug 20 zu berechnen. 

Dann wird der berechnete Wert PTpath in dem Speicher 72 0 
empfangen, der voreingestellten Speicherbereichen des RAM 
304 zugewiesen ist. 

15 Wenn die Korrektureinrichtung 712 den Wert PTpath von dem 
Speicher 720 empfangt, werden von einem Ziel-Of f set-Addie- 
rer 712a, entsprechend den Formeln (4) und (5), APT und 
ofs zu PTpath addiert. Somit werden wirklich modifizierte 
Daten PTmod erhalten. PTmod wird einer inversen kinemati- 

20 schen Umwandlungseinrichtung 714a der Roboter-Steuerein- 
richtung 714 zugefuhrt, und der Roboter 10 wird wie bei dem 
ersten Ausf uhrungsbeispiel gesteuert. 

Nun wird das Verfahren zum Berechnen von A PT erklart. Zu- 
25 erst werden die erfaBten Daten Ssen fur das Werkstuck W und 
die Bereichs-Mittelpunkts-Daten fur die Hand 18 von der Na- 
herungseinrichtung 704 empfangen. Letztere werden aus einer 
kinematischen Umwandlung bzw. Transformation erhalten- Dann 
wird auf die gleiche Weise wie bei dem ersten Ausfiihrungs- 
30 beispiel PSwall erhalten und im Speicher _706 gespeichert. 

Der PTpath am nachsten liegende Wert PSlwall wird durch das 
folgende Verfahren erhalten. Da es lange dauert, die Posi- 
tionsbeziehungen fur alle Werkstvickf orm-Daten PSwall zu be- 
3 5 rechnen, wird zuerst das geschlossene Intervalll [a,b], das 
das relevante Zeitintervall ist, auf die gleiche Weise wie 
bei dem ersten Ausf iihrungsbeispiel eingestellt. Der An- 



fangswert von a ist KHl-n, das das n-te Zeitintervall vor 
dem derzeitigen Zeitintervall KH1 ist, wahrend der Anfangs- 
wert von b das derzeitige Zeitintervall KH1 ist. n wird 
entsprechend Bearbeitungsbedingungen bestimmt, wie bei- 
spielsweise der Arbeitsgeschwindigkeit und dem Abstand zwi- 
schen dem Werkzeug und dem Sensor. 

Eine Vektor-Berechnungseinrichtung 708a in der Berechnungs- 
einrichtung 708 bestimmt unter Verwendung von Formel (29) 
und der Positions-Komponenten (Xpath, Ypath, Zpath) der 
Zieldaten PTpath und der Positions-Komponenten (Ox, Oy, Oz ) 
der Startpunkt-Daten des Lern-Vorgangs den Vektor L, der 
von dem Lern-Startpunkt bis zu PTpath reicht. 

L = (Xpath, Ypath, Zpath) - (Ox, Oy, Oz) ...(29) 

Aus den aus dem Speicher 706 ausgelesenen Positions-Kompo- 
nenten (Xwall(a), Ywall(a), Zwall(a)) von PSwall(a) im Zei- 
tintervall a und den Positions-Komponenten (Ox, Oy, Oz ) der 
Startpunkt-Daten des Lern-Vorgangs wird unter Verwendung 
von Formel (30) der Vektor 1(a) erhalten, der von dem Lern- 
Startpunkt bis zu PSwall reicht. 

1(a) = (Xwall(a), Ywall(a), Zwall(a)} - (Ox, Oy,. Oz) 

... (30) 

In einer Winkel-Berechnungseinrichtung 708b wird, wie bei 
dem ersten Ausf iihrungsbeispiel , der Winkel cose zwischen L 
und 1(a) erhalten. Eine Berechnungseinrichtung 708c zur Be- 
rechnung trigonometrischer Funktionen berechnet, wie im er- 
sten Ausf iihrungsbeispiel , unter Verwendung von 1(a) und 
cose, die entsprechend den vorstehenden Formeln erhalten 
werden, die Lange |lL(a)| des Vektors IL(a) , der eine Pro- 
jektion von 1(a) auf L ist. 

In einer Dif f erenz-Berechnungseinrichtung 708d wird, wie im 
ersten Ausf iihrungsbeispiel , die Differenz f(a) zwischen 
|lL(a)| und |l| erhalten. Unter Verwendung der im Speicher 
706 gespeicherten Daten des Zeitintervalls b wird f(b) 
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durch Wiederholen der Verarbeitungen der Berechnungsein- 
richtungen 708a bis 708d berechnet. 

Genau wie im ersten Ausf iihrungsbeispiel wird PSlwall von 
der Bestimmungseinrichtung 710 ausgewahlt, die den selben 
Aufbau wie die Pro jektions-Bestimmungseinrichtung 412 des 
ersten Ausf uhrungsbeispiels aufweist. 

Dann wird PTmod von der Korrektureinrichtung 712 berechnet, 
die ebenfalls die selbe wie im ersten Ausf iihrungsbeispiel 
ist, und der Roboter-Steuereinrichtung 714 zugefiihrt. 

Wie bei dem ersten Ausf iihrungsbeispiel wird der Roboter von 
einem Anomalie-Prozessor 726 und einer Anomalie-Erf assungs- 
einrichtung 728 wie jenen des ersten Ausf uhrungsbeispiels 
gesteuert, damit der Roboter nicht mit anomalen Daten ge- 
steuert wird. 

Das Verfahren zum Ausfiihren dieser Verarbeitungen in der 
zweiten CPU 3 01 wird nun erklart; die Erklarung der Verar- 
beitung in der ersten CPU 300 ist ausgelassen, da sie mit 
der des ersten Ausf uhrungsbeispiels iibereinstimmt . Das 
FluBdiagramm in Fig. 19 beschreibt die Funktion der zweiten 
CPU 301. 

Schritte 802 und 804, und Schritte 810 bis 836 werden auf- 
grund einer Multitasking-Verarbeitung parallel ausgefuhrt. 
Die Schritte 802 und 804 werden in einem Zeitzyklus des 
Sensor-Controllers 24 ausgefuhrt, wahrend die Schritte 810 
bis 836 in einem Zeitzyklus der Roboter-Steuereinrichtung 
12 ausgefuhrt werden. 

Schritt 800: Die zweite CPU-Karte wird initialisiert . 

Schritt 802: Die Positions- und Form-Daten . Ssen des Abtast- 
punkts werden von dem Sensor-Controller 24 empfangen. 



Schritt 804: Drehwinkel-Daten 6enc fiir jede einzelne Achse 
wercien simultan von den Winkelsensoren 34 , 44 , 54 , 64 , 74 & 
84 empfangen, wenn der Sensor 22 mit dem Abtasten beginnt. 

Schritt 810: PTpath wird von der ersten CPU 300 empfangen. 

Schritt 812: PSwall wird entsprechend den vorstehenden For- 
meln berechnet und in dem KH1 entsprechenden Speicherbe- 
reich des Speichers 706 gespeichert. 

Schritt 814: Das Suchintervall [a, b] zum Auswahlen von 
PSlwall aus dem Speicher 706 wird erhalten. Wie vorstehend 
beschrieben, sind die Anf angswerte : a = KHl-n und b = KH1 . 

Schritt 816: PTwall(a) wird aus dem Speicher 706 ausgelesen 
und der sich von dem Lern-Startpunkt bis zu PSwall (a) er- 
streckende Vektor 1(a) und dessen Lange |l(a)| werden unter 
Verwendung der vorstehenden Formeln erhalten. Zudem wird 
der sich von dem 'Lern-Startpunkt bis zu den Zieldaten PT- 
path erstreckende Vektor L unter Verwendung der vorstehen- 
den Formeln erhalten, und unter Verwendung der vorstehenden 
Formeln wird der durch 1(a) und L(a) bestimmte cos 9(a) er- 
halten. 

Dann wird der Vektor IL(a), der eine Projektion von 1(a) 
auf L(a) ist f sowie dessen Lange |lL(a)| entsprechend den 
vorstehenden Formeln erhalten. 

Schritt 818: Wenn fiir das Daten-Suchintervall [a, b] gilt 
f(a) < |L| , oder 
f(b) > 0, 

dann fahrt die Steuerung mit. Schritt 8 20 fort, bei dem die 
Anomalie-Verarbeitung ausgefuhrt wird, andernfalls fahrt 
die Steuerung mit Schritt 822 fort. 



Schritt 820: Das zuvor berechnete ^PT(KHl-l) verbleibt als 
^PT fur die derzeitige Verarbeitung und die Steuerung 
fahrt mit Schritt 83 4 fort. 

Schritt 822: Wenn die PTpath am nachsten liegenden Werk- 
stuckf orm-Daten gefunden sind, geht die Steuerung zu 
Schritt 830 iiber. Andernfalls fahrt die Steuerung mit 
Schritt 824 fort. Die Testbedingung, b - a < 1, ist er- 
fullt, wenn beide Endpunkte des Such-Intervalls am selben 
Punkt sind oder wenn sie aneinandergrenzen. 

Schritt 824: Da es viel Zeit in Anspruch nimmt, die Daten 
innerhalb des Suchintervalls sequentiell zu uberprufen, 
wird zum Beschleunigen der Verarbeitung das EinschluB-Ver- 
fahren verwendet. Auf diese Weise wird der Mittelpunkt des 
Daten-Suchintervalls [a, b] erhalten. 

Schritt 826: f (c) wird fur den Mittelpunkt c erhalten. 

Schritt 828: Wenn f(c) > 0 ist, wird c durch ein neues b 
ersetzt. Wenn f(c) < 0 ist, wird c durch ein neues a er- 
setzt. Dann kehrt die Steuerung zu Schritt 822 zuruck. 

Schritt 830: PSwall des aus dem Speicher 706 ausgewatilten 
Zeitintervalls wird gelesen, und dieses PSwall wird PSlwall 
zugewiesen. 

Schritt 832: Die Differenz R-ofs zwischen den ausgewahlten 
Werkstiickf orm-Daten PSwall und PTpath wird unter Verwendung 
der vorstehenden Formeln erhalten. Unter_ Verwendung von R- 
ofs und der Korektur-Auswahleinrichtung 712b wird mit den 
vorstehenden Formeln die Korrektur £±PT ermittelt, urn mit 
der Anomalie-Erf assungseinrichtung 728 auf Anomalien hin zu 
iiberpruf en . 

Schritt 834: Die modif izierten Daten PTmod werden aus PT- 
.path, A PT und ofs berechnet. 



Schritt 836: PTmod wird der ersten CPU 3 00 zugefuhrt, und 
, die Steuerung kehrt zu Schritt 810 zuriick. 

Der Roboter dieses zweiten Ausf uhrungsbeispiels erzielt die 
gleiche Wirkung wie der des ersten Ausf uhrungsbeispiels , da 
jedoch lediglich die Werkstuckf orm-Daten PSwall im Speicher 
gespeichert werden, kann bei diesem Ausf iihrungsbeispiel die 
Speicherkapazitat kleiner als bei dem ersten Ausfiihrungs- 
beispiel sein. 

Bei dieser Erfindung handelt es sich um eine Echtzeit-Spur- 
f olge-Steuereinrichtung fur einen einem Standard-Weg fol- 
genden Roboter, die einen Zielpunkt im voraus erfaBt, was 
eine hohere Arbeitsgeschwindigkeit erlaubt. Der Roboter 
verwendet beide, erfaBte Daten und zuvor gelernte Daten, um 
seine Aufgabe genau auszufuhren. Die genaue Steuerung wird 
erreicht, indem Zeitintervallen entsprechende Zielpunkte 
verwendet werden. Somit wird, selbst wenn die Geschwindig- 
keit oder der Weg wahrend des Betriebs geandert werden, 
eine genaue Spurfiihrung kontinuierlich ausgefiihrt. 



Deutschsprachige Ubersetzung der Patentanspriiche der 
Europaischen Patentanmeldung Nr. 89105819.0-2206 des 
Europaischen Patents Nr. 0 336 342 



1. Steuersystem ftir einen industriellen Roboter (R4), der 
einer Werkstuckf orm folgt, indem er einem durch zuvor in 
dem System gespeicherte Daten bestimmten Standard-Weg (s) 
folgt, und der eine Hand (Rl) mit einem Werkzeug (R 2 ) sowie 
einen in einem vorbestimmten Abstand vor dem Werkzeug (R2) 
angeordneten Werkstuckf orm-Sensor (R3) aufweist, wobei das 
System Abweichungen von dem Standard-Weg (s) in Echtzeit 
korrigiert, wahrend das Werkzeug (R2) in Betrieb ist, mit: 
einer Zwischenspeichereinrichtung (R5) zum Empfangen von 
wahrend dem Betrieb • des Werkzeugs (R2) erfaSten Daten und 
zum Berechnen und Speichern von Werkstuckf orm-Daten (Wd) 
unter Verwendung der erfaBten Daten; 

einer Interpolations-Bestimmungseinrichtung (R6) zum 
Auswahlen eines interpolierten Punktes (Sd) auf dem Stan- 
dard-Weg (S), wobei der interpolierte Punkt (Sd) einer 
Zielposition des Werkzeugs entspricht; und 

einer Roboter-Steuereinrichtung (R9) zum Steuern des Werk- 
zeugs (R2), um einer Folge von einer Zielposition entspre- 
chenden Punkten sowie Lagedaten von einer Weg-Korrekturein- 
richtung (R8) zu folgen; 
dadurch gekennzeichnet , daB 

die ausgewahlten Werkstuckf orm-Daten (Wd) mittels der 
Anordnung erhalten werden , mit: 

einer Auswahleinrichtung (R7) zum Erzeugen eines dem inter- 
polierten Punkt (Sd) entsprechenden Bezugspunkts (Nd) und 
zum Auswahlen der dem Bezugspunkt (Nd) am nachsten liegen- 
den Werkstiickform-Daten (Wd) , wobei der Bezugspunkt (Nd) 
erhalten wird, indem der von der Interpolations- 
Bestimmungseinrichtung (R6) ausgewahlte interpolierte Punkt 
(Sd) als Bezugspunkt (Nd) bestimmt wird, oder indem (1) der 
der derzeitigen Position des Werkzeugs (R2) auf dem Stan- 
dard-Weg (S) entsprechende Punkt als Startpunkt eingestellt 
wird und der von der Interpolations-Bestimmungseinrichtung 
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CR6) ausgewahlte interpolierte Punkt ( Sd) als Endpunkt ein- 
gestellt wird, wodurch ein Vector erzeugt wird, und (2) der 
Endpunkt des Vektors als der Bezugspunkt (Nd) hestimmt 
wxrd wenn der Startpunkt des Vektors als die dereeitlge 
POSltlon des Werkzeugs (R2) bestimmt wird; und 
exner Weg-Korrektureinrichtung ( R8 ) zum Erzeugen der 
' de" rllT ^ St6llUngS — "r das Werkzeug (R2) auf 

PuL 7sd? u g : f r DlfferenZ 2WiSCh€n dSln -terpolierten 
Punkt CSd) und den ausgewahlten Werkstuckf orm-Daten (Wd) . 

2 Steuersystem nach Anspruch 1, dadurch gekennzeichnet , 
daB d le Auswahleinrichtung (R7) enthalt: 

eine Bezugslinien-Berechnungseinrichtung zum Berechnen ei- 
ner Bezugslinie aus ■ entweder den Werkstuckf orm-Daten (Wd) 
oder dein Standard-Weg ( s ) ; 

eine Pro jektionseinrichtung zum Projizieren eines vorbe- 
Stlmmten Pr °3ektions-startpunkts auf die Bezugslinie; und 
erne Bezugslinien-Auswahleinrichtung zum Auswahlen der 
Werkstuckform-Daten mit der geringsten Entfernung zwischen 
einem projizierten Punkt und eine* vorbest immt en 
Vergleichspunkt auf der Bezugslinie. 

3. Steuersystem nach Anspruch 2, dadurch gekennzeichnet 
daB die Auswahleinrichtung eine Einrichtung aufweist zum 
Bestimmen der Bezugslinie aus den Werkstuckf orm-Daten (wd) • 
zum Bestimmen des Pro jektions-Startpunkts aus dem Bezugs- 
punkt, der eine genaherte, von dem Werkzeug (R 2 ) zu errei- 
chende, Werkzeugposition ist, wobei die genaherte Werkzeug- 
position aus dem Standard-Weg (s) und dem wahrend des Be- 
tnebs wirklich verfolgten Weg genahert W ird; und zum Be- 
stimmen des Vergleichspunkts auf der Grundlage von Da ten 
des Werkstuckf orm-Sensors (R3). 

4. Steuersystem nach Anspruch 3/ dadurch gekennzeichnet 
daB die Auswahleinrichtung (R7) die Bezugslinie aus der aus 
einem zwei benachbarte erfaBte Datenpunkte verbindenden 
Vektor, einem zwei in einem vorbestimmten Interval 1 erfaBte 
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Datenpunkte verbindenden Vektor und einem einen erfaBten 
Datenpunkt und einen Werkzeug-Ende-Punkt zum Zeitpunkt des 
Erfassens des erfaBten Datenpunkts verbindenden Vektor be- 
stehenden Gruppe bestimmt. 



5. Steuersystem nach Anspruch 2, dadurch gekennzeichent , 
daB die Auswahleinrichtung (R7) eine Einrichtung aufweist 
zum Bestimmen der Bezugslinie aus dem Standard-Weg (s); Z um 
Bestimmen des Pro jektions-Startpunkts auf der Grundlage von 
Daten von dem Werkstiickf orm-Sensor (R3); und zum Bestimmen 
des Vergleichspunkts aus dem dem interpolierten Punkt auf 
dem Standard-Weg (S) aquivalenten Bezugspunkt (Nd) . 
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FIG. 6 
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